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® Robot operation control system. 



© A robot operation control system for point-to-point move- 
ment is disclosed in which each motor is provided with a micro- 
computer (51. 52, 53) and a predetermined acceleration/decel- 
eration control is effected for each microcomputer, so that 
specified given points may be passed smoothly in a given se- 
quence. 
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ROBOT OPERATION CONTROL SYSTEM 

1 The present invention relates to a robot control 

system for point-to-point movement, or more in particular 
to a robot control system wherein given points specified 
in advance are passed in a predetermined sequence by 
5 distributed control with low-function microcomputers. 

In conventional robots controlled point-to-point , 
each joint angle of the robot is subjected to a closed loop 
control between a control system and a drive system to 
compute the next predicted angle each time of sampling. 
10 This type of control requires the computation of a multi- 
plicity of predicted angles for acceleration or deceleration 
following an acceleration /deceleration curve set according 
to a very short sampling time, resulting in a disadvantage 
that a high-speed high-performance microprocessor is 
15 required as a control unit with a complicated control 

software and large-scale circuit configuration. Further , 
a servo motor is used as an arm-driving actuator so that 
it is necessary to attain the high-speed rotation of the 
motor by use of a pulse generator of high resolution or 
20 a reduction gear of high reduction ratio in order to 
improve the positioning accuracy. 

The object of the present invention is to provide 
a robot operation control system wherein a robot .subjectjed 
to point-to-point control is adapted to pass prescribed 
25 given points in a predetermined sequence by distributed 
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1 control of low-function microcomputers without the need of 
complicated computations. 

In order to achieve this object , according to 
the present invention, there is provided a robot operation 
5 control system wherein each joint angle of the robot is 

subjected to an open loop control between a control system 
and a drive system with acceleration/deceleration being 
controlled by an independent acceleration/deceleration 
control section for each joint drive section, so that the 

10 control section subtracts a numeral proportional to the 
absolute angle of the present position from a numeral- 
proportional to the absolute angle of a target point (the 
number of pulses from the origin) and transmits a positive 
or negative sign (representing right or left turn) of the 

15 difference to the acceleration /deceleration control section 
thereby to control the robot operation. 

The present invention will be apparent from 
the following detailed description taken in conjunction 
with the accompanying drawings, in which: 

20 Fig. 1 is a diagram showing the appearance of 

a robot of SCARA (Selective Compliance Assembling Robot 
Arm) type using a control system according to the present 
invention ; 

Fig. 2 is a longitudinal sectional view of the 
25 same robot; 

Fig. 3 is a diagram showing a schem a tic construc- 
tion of an operation control system according to the present 
invention ; and 
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1 Fig- 4 is a diagram for explaining the operation 

of a control system according to the present invention 
with one or two shafts of a robot of SCARA type. 

The present invention will be explained below 
5 with reference to an embodiment shown in Figs. 1 to 4 . 
First, the construction and mechanism of the present 
system will be described with reference to Figs. 1 and 2. 
An iron base 1 of a control section has arranged thereon 
a metal cabinet 2 for the control section. The cabinet 2 
10 has a metal partition plate 5 for dividing the internal 

space thereof into a control chamber 3 and a power chamber 
4 . The control chamber 3 is hermetically sealed by the 
base 1, the cabinet 2 and the partition plate 5. A substrate 
8 with microcomputers is arranged within the control 
15 chamber 3. The power chamber 4 of the cabinet 2 has a 

vent 2a, and the power chamber 4 contains a power section 
10 such as a transformer and a fan 11. The fan 11, which 
is for cooling the power section 10 forcibly, cools the 
metal partition plate 5 at the same time, and therefore 
20 the control chamber 3 may be cooled sufficiently even if 
it is hermetically sealed. By hermetically sealing the 
control chamber 3 this way, it is possible to shut off 
dust and dirts thereby to improve the reliability of the 
microcomputer s 6 in the control chamber 3 . 
25 The control section cabinet 2 has secured thereon 

a cabinet 12 of iron plates to form a first drive chamber 
13.' A first arm 14 is horizontally rotatably mounted on 
the cabinet 12. The first drive chamber 13 contains 
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1 therein a first drive unit 15 for driving the first arm 
14. This first drive unit 15 includes a first drive motor 
16, a first lower belt 17, a first transmission device 
18 and a first upper belt 19. The first drive motor 16 
5 is of stepping type and secured on the cabinet 12 through 
a support plate 20 in such a manner that a rotary shaft 
16a thereof projects upward- Numeral 60 designates a first 
rotary type pulse generator connected to the rotary shaft 
of the first drive motor 16. The first transmission 

10 device 18 includes a central rotary shaft 18a rotatably . 
supported on upper and lower bearings 21a, 21b of a large 
channel-shaped support 21, a first lower disc 18b secured 
to the lower side thereof, and a small first upper disc 18c 
secured to the upper side thereof. The first lower belt 

15 17 is extended over the first drive motor rotary shaft 16a 
and the first lower disc 18b. The first upper belt 19, 
on the other hand, extends over the first upper disc 18c 
and the first arm rotary shaft disc 22a. The first arm 
14 includes a first lower arm 14a and a first upper arm 14b. 

20 The first lower arm 14a and the first upper arm 14b are 

made in light weight by plastic injection molding, thereby 
greatly contributing to a reduced capacity of the first 
drive motor 16. Also, since the first lower arm 14a and 
the first upper arm 14b have a section substantially 

25 channel shaped, the strength thereof is high on the one 
hand and the internal components thereof are easily 
reparable by removing the first upper arm 14b on the other 
hand. A rotary shaft 22 is secured to the lower side of 
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1 an end of the first arm 14. This rotary shaft 22 is 

projected into the cabinet 12 and is rotatably supported 
on "an upper bearing 23 on the cabinet 12 and a lower 
bearing 24 in the cabinet 12. The lower bearing 24 is 
5 secured on the cabinet 12 through a support 25. A large 
disc 22a is secured at the central portion of the first 
arm rotary shaft 22. When the first drive motor 16 is 
driven, the turning effort of the rotary shaft thereof is 
transmitted to the transmission device 18 via the first 
10 lower belt 17, and further to the rotary shaft 22 via the 
first upper belt 19, so that the first arm 14 is rotated 
by being decelerated behind the first drive motor 16. The m 
first drive motor 16 is arranged directly under the first 
arm rotary shaft 22 and compactly accomodated within the 
15 cabinet 12. The first arm 14 contains therein a second 
drive unit 27 for driving the second arm 26. The second 
drive unit 27 includes a second drive motor 23, a second 
lower belt 29, a second transmission device 30 and a 
second upper belt 31. The second drive motor 28 is of 
20 stepping type arranged above the first lower arm 14a 
through a support 32. Numeral 61 designates a second 
rotary-type pulse generator connected to the rotary shaft 
of the second drive motor 28. The rotary shaft 28a of the 
second drive motor 28 is projected downward. The second 
25 transmission device 30 includes a shaft 30a fixed on the 
first lower arm 14a and a first lower disc 30b and a 
second upper disc 30c rotatably supported on the shaft 30a. 
The second lower disc 30b is larger in diameter than 
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1 the second upper disc 30c. The second lower belt 29 is 
extended over the second drive motor rotary shaft 28a - 
and the second lower disc 30b. The first upper belt 31 
is extended over the second upper disc 30c and a second 
5 rotary shaft disc 33a. A second arm 26 is comprised of a 
second lower arm 26a and a second upper arm 26b. The 
second lower arm 26a and the second upper arm 26b are made 
in light weight by plastic injection molding/ thus gr eating 
reducing the capacity of the second drive motor 28. 

10 Further, the fact that the second lower -arm 26a and the 
second upper arm 26b form a substantially channel-shaped 
section leads to a high strength on the one hand and to 
the facility with which the internal components thereof 
is- reparable by removing the second upper arm 26b on the 

15 other hand. The second arm 26 has an end thereof inserted 
into an opening 14d of the other end of the first arm 14. 
The same end of the second arm 26 has mounted thereon a 
rotary shaft 33 vertically extending through the arms 14 
and 26 r which rotary shaft 33 is supported on the upper 

20 and lower bearings 14e and 14f of the first arm and has 
a large-diameter disc 33a at the central portion thereof. 
Upon energization of the second drive motor 28 / the turning 
effort of the rotary shaft 28a is transmitted to the second 
transmission device 30 through the second lower belt 29, 

25 and further to the rotary shaft 33 through the second upper 
belt 31, whereby the second arm 26 is rota-ted at a lower 
speed than the second drive motor 28. In view of the fact 
that the turning effort of the second drive motor 28 is 
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1 transmitted through the second transmission device 30 
to the second arm 26, the size of the disc 33a of the 
second arm rotary shaft 33 may be reduced s P that the 
outer diameters of both the first arm 14 and the second 

5 arm 26 may be reduced. 

The second arm 26 has arranged therein a third 
drive unit 35 for driving the third vertically movable 
shaft 34. The third drive unit 35 includes a third drive 
motor 36 and a third gear 37. The third drive motor 31> , 
10 which is made up of a stepping motor, is secured on a rib 
26c of the second lower arm 26a. Numeral 62 designates a 
third rotary type pulse generator connected to the rotary 
shaft of the third drive motor 36. The rotary shaft 36a 
of the third drive motor 36 is projected laterally. The 
15 third gear 37 has the ends thereof supported rotatably on 
an end of the second lower arm 26a and the rib 26e, and is 
adapted to engage the recesses and protrusions of the 
third vertically movable shaft 34. The third gear 37 is 
coupled to the third drive motor 36. 
20 T he third vertically movable shaft 34 extends 

through the second arm 26 and is supported vertically 
movably by supports 39 and 40. The third vertically 
movable shaft 34 is covered with a bellows member 43. A 
fourth drive motor 41 is secured on the lower end of the 
25 third vertically movable shaft 34 and has a rotary shaft 
41a thereof projected downward. This rotary shaft 41 is 
mounted with a gripper 42 or the like to relocate a machine 
part or other object to be handled. 
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1 Now, the control section will be described with 

reference to Fig. 3. A sequence control section 51 is 
for indicating the next target point on the basis of a 
point instructed through the I/O interface in accordance 

5 with a prescribed sequence. An operation control section 

52 stores therein the absolute number of pulses associated 
with *each axis of the target poifxt indicated by the sequence 
control section 51 and further has stored therein the 
absolute number of pulses associated with each axis of the 

10 present point. In the case where the arm is to be relocated 
to a target point specified by the sequence control section 
51/ the difference of the absolute numbers of pulses 
between the target point and the present point is computed 
and produced. Subsequently , the number of pulses for the 

15 target point is rendered to coincide with that for the 

present point. The number of pulses sent from the operation 
control, section 52 are applied to the drive control sections 

53 independently associated with each axis of the arm. 
Each of the drive control sections 53 produces an output 

20 for effecting acceleration/deceleration control along a 

predetermined curve in accordance with the number of pulses 
x sent from the operation control section 52. The output 
- from the drive control section 53 is converted at an 
excitation driver 54 into sufficient power to rotate the 
25 motor. Numeral 55 designates an actuator such as a stepping 
motor for rotating each shaft by a specified angle. A 
rotary- type pulse generator 70 (corresponding to the pulse 
generators 60, 61 and 62) connected to the output shaft of 
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1 the actuator is normally to generate a multi-phase pulse 
so that pulses determined by the rotational angle and 
rotational direction of the shaft of the actuator 55 are 
applied to a rotation monitor 71 . 
5 in the operation control unit according to this 

embodiment , the robot is instructed of the position of 
operation in such a way that by moving the arm directly by 
hand, the actuator is rotated . As a result, a pulse 
generator connected to the actuator generates pulses 
10 determined by the direction and rotational angle involved. 
By detecting these pulses at the rotation monitor 71, it is 
possible to automatically determine the amount of pulses 
corresponding to the specified position. In this manner, 
the robot may be instructed directly manually. When the 
15 hand of the robot is to move from point 62 to point 63, 

as shown in Fig. 4, the sequence control section 51 applies 
a signal of point 63 to the operation control section 52 
on the basis of sequence storaged in a memory. The 
operation control- section 52 reads the absolute number 
20 of pulses for each axis at the present point 62 and the 

target point 63 from the memory, computes by subtraction the 
direction and the number of pulses to be rotated for each 
axis, and applies the result thereof to the drive control 
section 53 for each shaft. 
25 Fig. 4 is a diagram for explaining the operation 

of this invention, in which reference numerals show the 
same members as Fig. 2. The arm 14 turns on the shaft 22 
and the arm 26 turns on the shaft 33. The 1,000 pulses 
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1 are applied to the drive control section 53 corresponding 
to the shaft 22 to rotate the stepping motor so that the 
arm 14 turns in the counterclockwise direction and at 
the same time, the 500 pulses of the polarity opposite to 
5 the pulses relating to the shaft 22 are applied to the 
drive control section 53 corresponding to the shaft 33 to 
turn the arm 26 in the clockwise direction, whereby the 
gripper 42 is moved from the present point 64 to the target 
. point 65- As a result, the arm 26 is rotated by an angle 

10 corresponding to the 500 pulses from a point of the 

absolute number of pulses 550 to a point of the absolute 
number of pulses 50. Thus, the drive control section 53 
for each axis proceeds to produce a predetermined number of 
pulses to the driver 54 at each sampling time so that the 

15 total number of pulses produced to the drive 54. is finally 
coincident- In this way, the tip of the hand of the robot 
may be controlled to move from point 62 to point 63 in 
an open loop. Also, it is also possible to monitor* the 
motor rotation for any -abnormality by the rotation monitor 

20 which compares the number of pulses produced from the 
motor with that produced from the pulse generator. 

The stepping motor, which has a high angular 
reproducibility, is very high in positional reproducibility 
after driving the motor by a predetermined number of pulses. 

25 According to the embodiment under consideration, 

the motor rotation may be easily checked for any abnormality 
by comparing the number of pulses applied to the motor 
with that produced from the pulse generator, and therefore, 
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1 should any trouble occur with the stepping motor attribut- 
able to the loss of harmony, the robot is stopped accord- 
ing to the amount of error involved. Further/ the robot 
operator is capable of freely programming the continued 

5 work after positioning the origin , thereby leading to 
the advantages of low cost and highly reliable robot 
control • 

Furthermore, in the above-mentioned control 
circuit, distributed control is possible with direct con- 
10 nection of single-chip low- function microcomputers, with 
the result that the number of parts is greatly reduced to 
make a compact control circuit possible. 

It will be understood from the foregoing descrip- 
tion that according to the present invention, the amount 
15 of movement of the arm may be automatically stored by the 
number of pulses produced from the pulse generator to 
instruct the robot on the position. Also, the only function 
of the control section is to sub tract the absolute number 
of pulses for the present point from the absolute number 
20 of pulses at the target point and the sole function of the 
acceleration/deceleration control section is to produce 
^ pulses and to compute by comparison the total number of 

pulses required as predetermined, resulting in the advantage 
that robot operation is controllable by distributed control 
25 of single-chip low- function microcomputers. 
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CLAIMS: 

1# In a robot operation control system- comprising 

a plurality of control sections (51, 52, 53) and a 
plurality of drive sections (54 f 55) driven by outputs 
from said control sections for controlling the point-to- 
point movement of an arm by the outputs of said drive 
sections, the improvement wherein a drive section is 
provided for each axis of said arm, said control section 
is provided for each said drive section, said arm being 
capable of passing specified given points in a given sequence 
by a predetermined acceleration/deceleration control of 
said each control section. 

2. An operation control system according to Claim 1, 

further comprising a rotation monitor (71) between each of 
said control section and each of said drive section thereby 
to subject said control section and said drive section to 
an open loop control. 
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